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Abstract 

We address the problem of attitude stabilization of a rigid body, in which neither the angular velocity nor the instantaneous 
measurements of the attitude are used in the feedback, only body vector measurements are needed. The design of the controller is 
based on an angular velocity observer-like system, where a first order linear auxiliary system based directly on vector measurements 
is introduced. The introduction of gain matrices provides more tuning flexibility and better results compared with existing works. 
The proposed controller ensures almost global asymptotic stability. The performance and effectiveness of the proposed solution 
are illustrated via simulation results where the gains of the controller are adjusted using non linear optimization. 


I. Introduction 

Attitude stabilization of rotational motion of rigid body is a classical problem. Despite the considerable existing solutions, 
it remains until today an active research topic. This is due to the large field of applications such as robotics, unmanned 
aerial vehicles (UAVs), satellites, marine vehicles, etc. The problem of attitude control was treated using several type of 
parametrization of the attitude JT). Classical solutions to this problem have been proposed using local-minimal parametrization 
which lies in R 3 , such as Euler angles or modified Rodriguez parameters (see, for instance, |[2), (3j, J4|, |j5)). The global-unique 
representation, which is the natural parametrization of the attitude is the direction cosine rotation matrix that lies in the special 
orthogonal group SO( 3). As a consequence, many recent solutions use this parametrization (see, for instance, J6), ||7], (8), l9l). 
However, for simplicity of analysis and numerical implementation reasons, a considerable number of solutions to the problem 
of attitude stabilization of rigid bodies rather use quaternion parametrization as global representation which lies in the unit 
sphere § 3 (see, for instance, iflOl , HT1 . 1121 . fl3l . 

Since attitude control and stabilization is as an interesting theoretical and technical problem, many scenarii were studied 
in the literature (see for instance uni, m, on, ns, m and 1201 ). The interesting and challenging scenario is the attitude 
stabilization without angular velocity. In fact, the main goal is to stabilize the attitude without the use of gyroscopes, which 
can be very expensive or vital to the system, like gyroscopes on Hubble used for pointing the telescope. They measure attitude 
when Hubble is changing its pointing from one target (a star or planet) to another, and they help control the telescope’s 
pointing while scientists are observing targets. There are a total of six gyroscopes on board-three serve as backups. In 2009, 
all six of Hubble’s gyroscopes had to be replaced and one can imagine the cost generated. At the light of these problems, it is 
conceivable to reduce costs and ensure continuity of the mission of the rigid body despite the failure of the gyroscopes when 
this type of controllers is used. Many works in the literature dealt with attitude stabilization without angular velocity problem 
(see, for instance 12TI . 1221 . (251 , 1241 . 1251 , 1251 , 1271 , (251 , If29l ). some of them exploited the passivity of the system such 
as (30), ED, (52), IBS, Ell¬ 
in almost all results dealing with the case of attitude control without angular velocity, the “instantaneous measurements 
of the attitude” are used in the control law. As there is no sensor which directly measures the attitude of a rigid body, the 
aforementioned velocity-free controllers require some kind of attitude observer relying on the available direction sensors. 
However, all static algorithms based only on body vector measurements are very sensitive to noise. Also, all the most efficient 
dynamic attitude estimation algorithms make use of the body measurements and the angular velocity information to estimate 
the attitude of the rigid body. To overcome this problem, a velocity-free attitude control scheme, that incorporates explicitly 
vector measurements instead of the attitude itself, has been proposed for the first time in 1241 . As claimed in f24l . this class 
of controllers can be qualified as the class of true velocity-free attitude controllers. 

Since it is impossible to achieve a global asymptotic stabilization using continuous time invariant state feedback |35l , the 
attitude control scheme presented in this work makes use the notion of “Almost Global Asymptotic Stabilization” (AGAS) of 
the closed loop system. Therefore, this work and that proposed in |24l present a stronger stability property compared to 11211 . 
where the convergence depends on a non trivial condition on initial conditions. 

The proposed solution given in this paper can be regarded as an continuation of 1241 . The main differences are the following: 
(a) the use of an auxiliary system in terms of body vector measurements, defined on R 3 , rather than that of an auxiliary system 
defined on S 3 ; (b) the explicit design of an angular velocity observer which is used in the design of the stabilizing feedback. As 
a consequence, the set of unstable equilibria of the closed loop dynamics of our auxiliary error system is reduced as compared 
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to that of lt24l . It is also shown that our auxiliary error system does not make use the inertial fixed reference vectors as in If24ll . 
The quaternion parametrization is used in the main analysis and the final results are rewritten with rotations expressed in 5*0(3) 
by simple projection. We also show that the introduction of gain matrices improves drastically the controller performance with 
respect to both |[24l and ETl . Moreover and contrarily to what is stated in (6), f24ll we prove that the set of control gains 
leading to a continuum of equilibria of the closed loop system is an algebraic variety of positive co-dimension, independently 
on the choice of the observed vectors. Finally, in order to adjust properly the controller gains, we rely a non-linear optimal 
tuning method. 

The result presented in this paper extends those from §22\ where a scalar gain was used in the control law. In addition, a 
complete and rigorous mathematical analysis is presented in this version. 


II. Notations and Problem Formulation 


A. Notations 

To perform a rotation in Euclidean space, we used either a rotation matrix R or a unit-quaternion Q = [go, g T ] T . We assume 

that R £ 50(3) = (f? £ R 3x3 | R T R = RR T = I 3x3 ,det(R ) = 1} and Q £ S 3 = {Q £ R 4 | Q T Q = 1}. The multiplication 

T _ t 

of two quaternions P = (po,P T ) T and Q = (qo,q T ) T is denoted by “©” and defined as P © Q = ^ ® 

|_ PoQ + QoP+P x q _ 

We use so(3) to denote the Lie algebra of 50(3), i.e., the set of skew symmetric matrices and we set S as the Lie algebra 
isomorphism from R 3 —»• so(3) which associates to x = [xi, x 2 , x 3 ] T the skew-symmetric matrix S(x) given by 


S{x) = 


0 -x 3 x 2 

x 3 0 —xi 
—x 2 X\ 0 


Note that for every x,y £ R 3 , one has S(x)y = x x y where x stands for the vector cross product. 
The mapping 1Z : § 3 —> S()(?>) given by Rodrigues’ rotation formula 


K(Q) =I 3 x3 + 2qoS(q) + 25(g) 2 , (1) 

defines a double covering map of SO( 3) by § 3 , i.e., for every R £ SO( 3) the equation 7 Z(Q) = R admits exactly two solutions 
Qr and —Qr. As a consequence, a vector field f of § 3 projects onto a vector field of SO(3 ) if and only if, for every Q £ § 3 , 
f(-Q) = —f(Q) (where we have made the obvious identification between TqS a the tangent space of 8 3 at Q and T_q§ 3 
the tangent space of S 3 at —Q). 

In what follows and for simplicity, the notations below are used. 

• If to is a positive integer, M m ( R) is used to denote the set of to by to matrices with real entries; O 3 , 03 n , 0 and I denote 
the 3 by 3 zero matrix, the 3 n by 1 zero vector, the 3 by 1 zero vector and the 3 by 3 identity matrix respectively; 

• {B} and {T} denote an orthonormal body-attached frame with its origin at the center of gravity of the rigid-body and 
the inertial reference frame on earth respectively. 

Lor every x,y £ R 3 and a given R £ SO( 3) one has the following [ 37l 

S(x)y = -S(y)x, S(x)x = 0, 

S(x)S(y) = yx T — x T yI, S 2 (x) = xx T — x T xI, 

S(S(x)y) = S(x)S(y) — S(y)S(x), S(Rx) = RS(x)R T . 


B. Problem formulation 

Let n > 2 be an integer. The attitude kinematics of a rigid body in 3D space is given by 


R(t) = R(t)S(u}(t )), 


( 2 ) 


where R £ S()(?>). The equivalent kinematics evolving in § 3 are given by 


Q(t) = 


4o (t) 


-\q T (t)u{t) 

q(t) 


. h(qo(t)I + S(q(t)))w(t) _ 


(3) 


where ui(t) being the angular velocity of the rigid body expressed in {£>} and Q £ § 3 is the unit quaternion. Let bi(Q(t)) £ R 3 
(i = 1, • • • , n) be a measured vector expressed in {£>}. The relation between &*(£) and its corresponding fixed inertial vector 
Vi £ R 3 are given by 


bi(Q(t)) = R T (t)n 


As a consequence we have bi{—Q) = bi(Q) for 1 < i < n and Q £ § 3 . 
Using (0 and (0, one can get the reduced attitude kinematics 


( 4 ) 
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k(Q(t)) = -S(w(t))bi(Q(t)), i = 1, • ■ ■ , n. (5) 

The simplified rigid body rotational dynamics are governed by 

Jd)(t) = —S(uj(t))Ju}(t) + r(t), (6) 

where 

. J g R 3x3 is a symmetric positive definite constant inertia matrix of the rigid body expressed in {£>}; 

• r(f) is the external torque applied to the system expressed in {£>}; 

• uj(t) being the angular velocity of the rigid body expressed in {£>}. 

The problem addressed in this work is the design of an attitude stabilization control r(f) based only on inertial measurements 
bi(t), without using the angular velocity U)(t) in the feedback. 

C. Assumptions 

We make the following assumptions for the rest of the paper. 

A 1 We assume that only the n vector-valued functions of time 6 ,(f) are measured and we do not make any similar 
assumption on angular velocity vector ui(t). Moreover, note that the bfs actually depend on the rotation R and one 
could also write them as bi(R(t)) or 6,;(<3(f)) if we choose quaternions instead of rotations. In the sequel, we will 
write either 6 ,(f) or 6 j(Q(f)). 

A2 At least two vectors n, r 2 are non collinear. As a consequence, 61 (f) and 62 (f) are linearly independent for all non 
negative times. 

A3 The desired rigid body attitude is defined by the constant rotation matrix Rd, relates an inertial vector r, to its 
corresponding vector in the desired frame, i.e., bf = R^ti, with bf = 0. An equivalent constant desired unit- 
quaternion Qd is defined as Rd = 7 Z(Qd). 

III. Handling the lack of angular velocity and Design of the attitude controller 
A. Angular velocity observer-like system 

As well known, the reduced attitude kinematic is defined by (j5j- Define T = diag{ Ai, • • • . A„ ), where A, is a symmetric 
positive definite 3x3 matrix, for 1 < i < n. Define the symmetric matrix M(t) = Yn=i <S'( 6 i(f)) T AjS'( 6 i(f)), which is 
positive definite thanks to Assumption A2. 

Multiplying 0 by 5(6j(f))Aj for 1 < i < n and doing the sum gives 

n 

y]/S( 6 i(t))AA(f) = -M(t)w(t). (7) 

i= 1 

From 0 the true angular velocity ui(t) is given by 

n 

w(t) = M-\t ) Y, 5(6 < (f))A i 6 i(t ) ( 8 ) 

2=1 

Since bi(t) is not a measured quantity, we propose the following new angular velocity observer-like signal 


W(f) = - M~\i) Y S(bi(t))AMt), (9) 

2 = 1 


where the vector 6 i(f) can be viewed as an estimate of the vector b, (t) using the following linear first-order filter on 6 ,. 

(*=!,••• ,n). 


6j(f) = Aj(6j(f) — 6*(f)), (10) 

where the constant matrices A, £ R 3x3 are chosen as Aj = R^Pi{Ai)Rd, for 1 < i < n, with Pi polynomial of degree two 
which is positive on R^_. As a trivial consequence, one deduces that, for 1 < i < n, RdA, Rj is symmetric positive definite 
and commutes with A*. Set A = diag(Ai 1 • • • , A„) and Ad = diag(RdAiR^ , • • • , RdA n R J). Then T and Ad commute. 

We define an error for the linear first-order filter by 6 j(f) = 6 , (f) — b,(t). Using (TTTTb . Q leads to the following error 
dynamics 6 j(t) = — Aj 6 j(f) + S(bi(t))ui, which can be rewritten using the state vector defined by £(f) := [ 6 f (f), • • • , 6 ^(f)] T , 


as 


£(t) = -A£(t) + B(t)u(t), 


( 11 ) 
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where B(t) =[ S(b 1 (t)) T S{b n (t)) T ] 1 . 

Finally, the angular velocity observer-like signal can be written as 

w{t) = M~ 1 (t)B T (t)TA£(t). (12) 


B. Controller Design 

First, the orientation error is defined by 

R{t) = R(t)R T d , (13) 

where R(t) is a rotation matrix and R d is a constant desired rotation matrix. From {2} and ( IT3T > one can obtain the attitude 
dynamics errors in term of matrix rotation as follows 

R(t) = R(t)S(R d u(t)), (14) 

R(t) correspond to the quaternion error Q(t) = Q(t ) © Q d {t) = [qo{t), q(t) T ] T whose dynamics is governed by 

qo{t) 

qif) 

The reduced orientation error is given by bi(Q(t)) = bi(Q(t )) — bf. Therefore, on can get 

h(Q(t)) = RT(R(t) T -I) n , (16) 

where 1 < i < n which can be rewritten using © as 


L 2 


-\q ( t)R d u(t) 
b (qo(t)I + S (q(t))) R d u(t) 


(15) 


bi(Q(t )) = -2R%(q Q (t)I - S(q{t)))S(q(t))n. 


(17) 


We propose the following control law 


r(f) = z p (t) - Mw{t), 


where the term z p {-) was introduced in If24l and is given by 

n 

z p(t ) = ^2pi s (bt) b i, 

i—l 

where the coefficients s are arbitrary positive constants. Define 


(18) 


(19) 


n 

W p = ~Y J PiS\r i ), (20) 

i—l 

The matrix W p is positive definite, see Lemma 2 of |[24) . Then, it has been shown in Lemma 1 of l24l that one can actually 
rewrite z p (-) as 


Z p (t) = —2i?J (q 0 (t)I - S(q(t)))W p q(t). 

One finally gets that the controller r(-) can be expressed as 


( 21 ) 


r(t) = -2 R d {q 0 {t)I - S{q{t)))W p q{t) - (22) 

Using (fTTl ). (fl5l i. ©I and < 1 22 b . we obtain the following closed loop dynamics 

r i = -m+b(q)u, 

I qo = -\q T R d u, 

I q = 1 + s (q))R d v, 

[ Jcb = —S(u})Joj — 2R d (qoI — S(q))W p q — Muj. 

One can make a further simplification by changing variables as follows: 

£ [RdbT{Q(t)), ■ ■ ■ ,Rd b n(Q(t))] T , u) —>■ R d u- 


By setting 


J d := R d JR d , B d := [ S{R d b X ) T ■ ■ • S(R d b n ) T ] T , 
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and by making obvious abuse of notations 
equation 


£ 


(i.e., we keep the variables £ and u>) we end up with an autonomous differential 


— A d (j + B d uj, 


qo = -^q w, 

q = \(qoi + s (q)) u > 

J d io = —S(uj)J d u) — 2(q 0 I — S(q))W p q — BjTA d f. 


Note that J d is a real symmetric positive definite matrix. If one defines the state x '■ z (£■ Q, w) where Q = 



and the state space T := R 3n x S 3 x R 3 , one can rewrite (l24b as \ = P{x) where F gathers the right-hand side of (l24b and 
defines a smooth vector field on T. Moreover, note that Q and -Q represents the same physical rotation, implying that (1241 ) 
projects on 50(3) as an autonomous differential equation. We will use that fact in Subsection ??. 


Lemma 1. With the notations above, one gets that the matrix W p defined in (120b has simple eigenvalues generically with 
respect to p = (pi, • • • , p n ) E (R+) 71 . 

Proof: For p E (R^)", let P p (-) be the characteristic polynomial of W p and A (p) its discriminant |[38l . Recall that 
A(p) = 0 if and only if P p (-) admits a multiple root. Since W p is a 3 by 3 real symmetric positive definite matrix or every 
p S (Rjj_) ra , A (p) is actually a homogeneous polynomial of degree four in p. Thus the locus A (p) = 0 defines an algebraic 
variety of co-dimension one in (R^) n and, on its complementary set S in (R+) n , W p has simple eigenvalues. ■ 

This genericity result serves a justification to the following working hypothesis, which will hold for the rest of the paper. 


(GEN) Wphas simple eigenvalues. 


IV. Stability Analysis of the Proposed Controller 

In this section, we present a rigorous analysis using two representations. As often, it turns out that it is simpler for the 
stability analysis to use unit quaternions for the representation of rotations instead of elements of 50(3), even-though we are 
ultimately interested in a result formulated in terms of orthogonal matrices. This is why we first complete the stability analysis 
and obtain a first theorem (Theorem [TJ using unit quaternions and, in a second step, we state our main result in terms of of 
elements of 50(3) by simply projecting Theorem |T| using Rodriguez formula ©. 

Lemma 2. Under the hypothesis (GEN), the solutions of equation z p = 0 where z p is defined by ( 1 27b are the following: (a) 
the two points ±(1,0); the six points ±(0,Uj), 1 < i < 3, with {vi,V 2 ,Vs) being an orthonormal basis diagonalizing W p . 

Proof: Let ( qo , q) E § 3 such that z p = 0, i.e., 

(q Q I - S(q))W p q = 0. 

If qo 0, it is immediate to see that qol — S(q) is invertible and thus q = 0 , finally implying that qo = ±1. If qo = 0, we 
are left with the equation S(q)W p q = 0. According to the properties of S(q) with q E § 2 , we get that q is an eigenvector of 
W p with unit length. We conclude by using (GEN). ■ 

Consider the following non negative differentiable function V : T —>• R + 

V = £ T r A d £ + 4 q T W p q + uj T J d u, (25) 


which is radially unbounded over T since W p and J d are positive definite. Moreover, since F and A d commute, the gain 
matrix TA d symmetric bloc diagonal positive definite. 


Theorem 1. Consider System (O-©, under assumptions in sub-section ill- Cb and the control law ( 122b with the auxiliary 
system given by m Then, if Hypothesis (GEN), holds true, one gets that 

( 1 ) there are eight equilibrium points, given by 


V+ = ( 0 3n , 


1 

0 


0 ): ^1 — (O 3 n> 


-1 

0 


0 ), 0+ 3i4 = ( 0 3n , 


0 

Vi 


, 0), 122,3,4 — (O 3 


-Vi 


0 ), 


with (vi , i’ 2 , V 3 ) is an orthonormal basis diagonalizing W p . 

(2) All trajectories o/©-© converge to one of the equilibrium points defined in Item (1). 

(3) Set c := 4,A m i n (W p ), where A m i n (W p ) is the smallest eigenvalue ofW p . Then the equilibrium point is locally 
asymptotically stable with a domain of attraction containing the set 


K + := {X G T | V(x) < c : and q 0 > 0} 


(26) 
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and the equilibrium point is locally asymptotically stable with a domain of attraction containing the set 

V~ := {x £ T I V(x) < C and q 0 < 0} . 


(27) 


(4) The other equilibrium points fi ^ 34 are hyperbolic and not stable (i.e. the eigenvalues of each of the corresponding 
linear systems have non zero real part and at least one of them has positive real part). This implies that System 
0 -© is almost globally asymptotically stable with respect to the two equilibrium points 12 + in the following sense: 
there exists an open and dense subset T 0 C T such that, for every initial condition £ T 0 , the corresponding 
trajectory converges asymptotically to either 12 + or 12 j”. 

Proof: Regarding Item (1), one must solve the equation f(x) = 0- where / is the nonlinear function describing <f24t . 
Two cases can be considered. Assume first that qo ^ 0. Both matrices qol + S(q) and qol — S(q) are non singular. Therefore 
from the third equation of El ui = 0 and thus £ = 0 :i „ from the first equation of ( 1241 . The fourth equation of (l24l> reduces 

' 0 ) and 


to z p = 0 and one concludes that q = 0 and f / 0 = ± 1 leading to two equilibrium points : 12 + = ( 0 3n , 


0 


= ( 0 , 


3 n? 


-l 

o 


, 0 ). 


Assume that qo = 0. Then | <y | = 1 and according to the third equation of (124b . one gets that oj is parallel to q. let say 
R d u: = pq and then p must be equal to zero according to the second equation of ( 1241 . implying that ui = 0. As in the previous 
case, one deduces that £ = 0: !n . The fourth equation of ( 1241 yields that q and W p q are parallel, leading to the six points 12 + 3 4 . 
We now turn to an argument for Item (2). Using the facts that 

cu T S(w) = 0, q T W p (q 0 I + S(q))u = co T (q 0 I - S(q))W p q , io T B T Ff = £ t TS W , 

the time derivative of d25l) in view of ([241 yields 


V = —£ t A£ < 0, 


(28) 


since A = A^TA d + TA 2 d = 2 TA 2 d is symmetric positive definite. We deduce that all trajectories of (l24l > are defined for all 
times and bounded. 

Since (l24l > is autonomous and V is radially unbounded, one can use LaSalle’s invariance theorem, cf. ( 1281 . Therefore every 
trajectory converges to a trajectory 7 along which V = 0. Then £ must be identically equal to zero, implying at once that 
BdOJ = 0 as well. The latter assertion yields that ui must be collinear to all the bps, which can be true only if uj = 0 since 
there are at least two non-collinear vectors bi. From the fourth equation of (f24t one can conclude that z p = 0 leading to the 
conclusion by Lemma [2] 

We next address Item (3). We provide a proof only for 12+ since the other case is entirely similar. Take an initial condition 
X in (If. Since V is decreasing, the corresponding trajectory stays in V r + for all times and, for every t > 0, q(t) T W p q(t ) < 
X rn in(W p ). This implies that ||g(f)|| < 1 for every t > 0 and thus qo(t) 0 for every t > 0. We deduce that qo(t) keeps the 
same sign namely that < 7 n (0), which is positive. Since the trajectory converges to one of the eight equilibrium points, it must 
be 12+ since this is the only one contained in Vjf. 

We finally provide an argument for Item (4). First of all notice the equilibrium points 12+, i = 2,3,4, cannot be locally 
asymptotically stable. Indeed let 12 be one of these points and U any open neighborhood of 12 in T. Define 


Va ■■= {X £ T | V(x) < V(n} , 

and set U~ := (Vfj FI U ). The set U~ is obviously non empty since it contains points of the type A12 with |A| < 1 close 
enough to 1 . Moreover, for every 7 G U~, the trajectory of (l24l > does not converge to 12 since V is non increasing. 

We next prove that the linearization of (l24l > at 12 is hyperbolic and admits an eigenvalue with positive real part. We first 
perform a change of variables. If qo = 0 then q = crv p , where a = ±1 and v p is an eigenvector of W p . Let us use the following 
change of variable (cf. f 8 |, 0, ll39l ) 


From (|29| > we have 


X = 

X 0 

_ 

0 

© 

qo 

= O 


X 


-Wp 


q 



T - 

v p q 

-q 0 v p - S{v p )q 


qo 


0 

© 

X 0 



— 



= a 

q 


av p 


X 



T 

-v p x 

x 0 v p + S(v p )x 


Rewrite (El using El gives 


f £ = —A d f + B d (X)uj 

• IT 

I X'o = ~2 X 10 

1 x = | (xol + S(x))ut 

{ Jdio = -Bj(X)TA d £ - S(u)J d u + 2 (x 0 I - S(x)) (X p I + S(v p )W p S(v p )) x. 


(29) 

(30) 


(31) 
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Since the tangent space of § 3 at 


(0 3 n> 


1 

0 


, 0 ) is given by 


1 

0 


is given by the equation xq = 0 , the linearization of System (TTTIt at il 2 


(£, X, w) = 



—A d 

0 

H 

Z = AZ , with A = 

o 3 

0 3 

h/2 


-J- l H T VA d 

2J- 1 G 

0 3 


(32) 


where Z = {zj, zj.. z^) T , z%, z x , z u are the linearized vectors of £, x, u, respectively. G = X P I + S(v p )W p S(v p ) and 
H = [ Hi ■ ■ ■ H% ] T with Hj = S ( Rd (/ + 2 S 2 (v p )) b'j). Since f 1 is not locally asymptotically stable, it is enough to 
show that A does not admit any eigenvalue with zero real part. 

Reasoning by contradiction, we thus assume that A has an eigenvalue il, l > 0, with Z l = (zJ,Z 2 ,zJ) T £ C 3n+6 a 
corresponding eigenvector. One gets the linear system of equations 

{ -A d zi+ Hz 3 =ilzi, 

z 3 /2 = ilz 2 , (33) 

-J d - 1 tf T r4^ 1 + 2 J d 1 Gz 2 =ilz 3 . 


If l = 0, one gets z 3 = Z\ = 0 (since A d is positive dehnite) and JJ 1 Gz 2 = 0. Recalling that W p is real symmetric with 
distinct eigenvalues, we have that 

W p = A p v p v^ + XiviVi + X 2 v 2 V2, 

where (v p , Vi, v 2 ) is an orthonormal basis of K 3 made of eigenvectors of W p . By using the properties of S(v p ), one gets that 

G = XpV p v T p + (A p - X 2 )v\Vi + (A p - X\)v 2 V2, 


implying that det(G) = A P (A P — Ai)(A p — A 2 ) 7 ^ 0 and thus z 2 = 0. Then the eigenvector Z is equal to zero, which is 
impossible. 

We deduce that l > 0. One deduces that Z\ = (A d + HI 3n )~ 1 Hz 3 , z 2 = —^ jz 3 and 

(%(Jd + G/l) + H T FA d (A d + i lI 3n )~ 1 H)z 3 = 0 . (34) 


Note that 

n 

H T YA d (A d + i Ihn^H = J2 HjKjAjiAj + 

3 =1 


Recall that, for 1 < j < n, Aj = 7 p (A 5 ) where Pj is a polynomial of degree two which is positive on R!j_. One deduces that 


Hfk j A j {A i +ilI 3 )- x H j =Y. 


^jkPj(Xjk) 


^P^)Tii WjkW ^ 


where ((H■ 1 ) T Wji, {H- 1 ) T Wj 2 , {H- 1 ) T Wj 3 ) is an orthonormal basis diagonalizing A j. 
Multiply Equation (f34t on the left by (z 3 ) T . We get 


n 3 


i{ z 3 ) T i}Jd + G/l)z 3 + ^ ^ 
7=1fc =1 


jkPj{Xjk)(Pj{Xjk ) il) ,, ,, T 


PjM 2 + i 2 


(( z *y Wjk y = 0, 


where l > 0. Since {z 3 ) T (lJ d + G/l)z 3 is a real number, we get 

n 3 




We deduce at once that z 3 = 0 and finally Z = 0, which is again a contradiction. 

If A does not have eigenvalues with positive real part, it would have only eigenvalues with negative real part and thus A 
would be Hurwitz, implying that (l24l) would be locally asymptotically stable with respect to il. Since this is not true, we get 
that A does admit at least one eigenvalue with positive real part. We hence proved that there exists an unstable manifold of 
dimension at least one in neighborhoods of the S2j , j = 2, 3,4, and since all trajectories converge to an equilibrium point we 
deduce that (l24l > is almost globally asymptotically stable with respect to the two equilibrium points ■ 











V. Control Gains Tuning and Simulation Results 


This section provides a procedure to have ’’optimal” gains (usually local) but approaching as near as possible to the global 
solution. The effectiveness of the proposed velocity-free attitude stabilization controller will be shown using simulation results. 

We denote a state vector \ = ( r 1 ■ Q, ui), where we take two non collinear vectors b \, 62 . For simplicity and without 

L 02 J 

loss of generality we take Rd = /, which means that q = q and bf = ri. The matrices Ai, A 2 are chosen diagonal such as 
A i = diag('yn, r yi 2 -, r yi 3 ) where i = 1 , 2 , therefore the matrices Ai, A 2 will be A,; = a^I + anAi + a» 2 A? where ( = 1 , 2 . 

In what follows, the following parameters are the same: the initial angular velocity w(0) = [0, 0, 0] T , the inertial reference 
vectors rq = [0, 0, 1] T and r 2 = [1, 0, 1], the inertia matrix J = diag( 0.5, 0.5, 1), simulation sample time is 0.01s with RK4 
algorithm. The notation “TRB controller” will be used to design the controller proposed in the paper 


A. Parameters Tuning 


Let us define the problem. Consider the case when we use two non collinear inertial fixed vectors rr, r 2 (i.e. n = 2) 
and we use the quaternion formulation of the closed loop dynamics (l24l ). Consider now an objective function g{n) such 
that k is the vector of all parameters to be tuned. The problem consists of finding min(g(n)) with the following constraint 

K 

Z(k(to)) < K.(m) < u(n(m)), where k = [ p\ P 2 a i(j-i) a 2 (j-i) 7i j 72 j ] T (j = 1,... ,3, (K7j_) is the vector 

of parameters), /(re (to)) and w(k(to)) are the lower and upper bounds corresponding to each parameter and k(?ti) is an element 
of K. 

Generally, optimization algorithms find a local optimum. It depends on a basin of attraction of the starting point. Also, the 
effectiveness of existing algorithms depends on the lower and upper limits. These last values can be determined based on the 
dominant poles of the linearized system around the stable equilibrium point. 


The linearization of (f24l i at Op = (06, 


1 

0 


, 0) can be written as follows 


{ z^ — — Az£ + Gzu 

Zq = \z u (35) 

Jz u = ~G T TAz^-2W p z q , 


where G = [ Gj GT, ] T with Gi = 5(rj), T and A are defined in Subsection IIII-AI and W p is defined in (l20t . Setting 
Z = (zj, z J, zJj ) T with £ R 6 , z q £ R 3 and z^ £ K 3 are the linearized vectors of £, q 1 uj , respectively. Then System (1351) 
can be rewritten as Z = BZ, where 


B = 


-A 0 3 G 

O 3 O 3 T 3/2 

—J~ 1 G t TA -2 J~ l W p 0 3 


Note that we used the fact that z qo = 0. The linearization of the closed loop dynamics is used to determine the upper and 
the lower limits uki , respectively, for each parameter. Let’s take an arbitrary initial condition in Euler angle [p. 6 , ip\ = 
[30, 10, 45]° corresponding to <5(0) = [ 0.8804, 0.2704, —0.02089, 0.3891 ] T . For an arbitrary chosen fixed k(to), to = 
3,..., 14 gains values, we start by varying k (1) and re(2). After inspecting the zero-pole map, one can determine an upper 
and lower bounds for re( 1) and re:(2) gains based on the placement of the dominant pole, if it exist. Same reasoning gives the 
values in Table [T| 

Objective Functions and Optimal Control Gains Tuning: Since there exist many possibilities to select the objective function, 
we tests different objective functions derived from three well known performance index. The first is Integral of Absolute 
Error (IAE), the second is Integral of Time-weighted Absolute Error (ITAE) and the last is Integral of Square Error, with 
the possibility to minimize energy and attitude error in the same time or not, by choosing er £ [0 1]. The first con¬ 
clusion after several simulations is that the most appropriate objective function for our application is the ISE function 
g ise ( K ) = / 0 °° (||q|| 2 + PMI 2 ) dt with er = 0.1. Indeed, it minimizes convergence time of the quaternion error and gives a 
comparable energy consumption to the “TRB controller”, as we will see after. Initial gain vector are chosen arbitrary as 
re 0 = [6, 6, 1, 0.4, 0.01, 1, 0.4, 0.01, 12, 11, 1, 10, 10, 10]. 

To get an idea of the effectiveness of the optimization used methods, we compare three functions to calculate gains optimally. 
The first one uses KNITRO, the second one is based on the use of the Matlab fmincon function and the third method is based 
on the use of the same function as the second method with variation of initial conditions of the parameters in a procedure 
called global search because the locality of the solution essentially depends on the initial conditions. The best one is the third 
one, i.e., the global search method and the final value k final with criterion ISE is presented in Table HII The corresponding 
gain matrices are presented in Table [HI] 
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B. Simulation results 

Let us now show the impact of the tuned gains on the nonlinear behavior of the new controller and the effectiveness of 
the proposed controller compared with “TRB controller”. We therefore choose the same gains presented in li24l for the “TRB 
controller” and the same initial condition <3(0) = [ 0.8, 0, 0, 0.6 ] . The evolution of the unit-quaternion trajectories with 
respect to time for the new and “TRB controller” are presented in Figure [I] where the state trajectories converge asymptotically 
to the equilibrium point . Figure [2] show the torque applied in the two controllers. It is clear that the introduction of matrix 
gains gives better results with a comparable energy effort for the two controllers. 

Figure [3] illustrate that the proposed controller and “TRB controller” can avoid the unwinding phenomenon, where the 
state trajectories converge asymptotically to the equilibrium point f2j~ when starting from the initial condition Q(0) = 
[ —0.8, 0, 0, 0.6 ] . But, it is clear that the new controller present better performances. Figure [T] show the appearance 
of the real angular velocity for the two controllers. 

Remark 1. Note that even if the initial condition is a theoretical unstable equilibrium point, we verified by simulation that the 
numerical errors push the trajectories far from this point. 

Remark 2. The controller proposed in IfZTI was tested. After many simulations, using several initial conditions, the first 
conclusion is that the convergence of quaternion trajectories corresponding to the proposed controller in the present work and 
“TRB controller” are, at least, ten time faster. The second conclusion is the fact that the performance of the controller proposed 
in lETl exhibit poor performances when only two inertial vectors are used compared to what is presented in l2ll . where results 
use three vectors. 




cr 



time (s) 


Figure 1. Quaternion trajectories for the new and TRB controllers with Q(0) = 


0.8, 0, 0, 0.6 ] T 


VI. Conclusions 

We have proposed an attitude stabilization controller for rigid body, in which neither the angular velocity nor the instantaneous 
measurements of the attitude are used in the feedback. This controller could be of great help (as main or backup controllers) 
in applications where prone-to-failure and expensive gyroscopes are used. When almost all existing solutions to this problem 
use the instantaneous attitude measurements, while it is well known that efficient attitude observer use the angular velocity 
to obtain an accurate results, our approach overcomes totally reconstructing the attitude. It mainly uses an auxiliary system 
that can be considered as an observer of the angular velocity using only the inertial measurements. The proposed controller 
doesn’t use the inertial fixed reference vectors, reduces the set of unstable equilibria of the closed loop dynamics with respect 
to previous proposed controller, provides an almost global stability of the desirable equilibrium and avoids the "unwinding 
phenomenon". In addition, it was shown that the set of control gains leading to a continuum of equilibria of the closed loop 
system is an algebraic variety of positive co-dimension, independently on the choice of the observed vectors. A non-linear 
optimal tuning method have been used to adjust properly the controller gains. We illustrated that the introduction of matrices 
gains gives a better results compared with existing work. The performances and effectiveness of the proposed solution were 
illustrated via simulation results. 
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gains 



Pi(i = 1 , 2 ) 

0.01 

30 

«io(* = 1, 2) 

0.0001 

4 

an(i = 1, 2) 

0.0001 

2 

<H2{i = 1, 2) 

0.0001 

0.1 

7i.?(* = f.2,i = 1,2,3) 

0.01 

50 


Table I 

Lower and upper limits 


gains 

ISE g iae (K) = J ™ (HgP + 0 . 1 || t ||^) dt 

pi(i = 1,2) 

[22.5408, 1.7736 ] 

“if,-1)0' = 1,2,3) 

[4, 2, 0.1] 

a 2(7-l) 0 = 1> 2, 3) 

[3.9672, 2, 0.1] 

71,0 = 1,2,3) 

[50, 28.7599, 0.0971] 

72,0 = 1,2,3) 

[1.8614, 1.7403, 13.9601] 


Table H 

Selected optimal gain values 


parameters 


values calculated with ISE criterion 


Ai 


diag([50, 28.7599, 0.0971]) 


A2 


diag([l.S614. 1.7403, 13.9601]) 


diag([550, 255.2727, 0.5838]) 


A 2 


diag([ 11.4541. 10.6873, 102.7916]) 


W T 


24.3144 0 —1.7736 

0 26.0881 0 
-1.7736 0 1.7736 


eigenvectors 


v p 1 = ± 


0.0780 

0 

0.9970 


of W rho 

V P 2 = ± 

-0.9970 ' 
0 

, V p 3 = ± 

0 

-1 



0.0780 


0 


eigenvalues 
of W rho 


A p i = 1.6349, \p2 = 24.4531 
A p3 = 26.0881 


Table III 

Gain matrices 




